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ABSTRACT 

U.S.  Army  RDECOM-TARDEC,  in  collaboration 
with  Oakland  University  and  JADI  Inc.,  is  currently 
conducting  novel  research  devoted  to  obtain  fine-grain 
(centimeter  accuracy)  indoor  positioning  for  unmanned 
ground  vehicle  (UGV)  navigation  applications  using 
Ultra- Wideband  (UWB)  technologies.  This  paper  will 
present  recent  results  from  advanced  closed-form 
solutions  and  analyses  for  positioning  errors,  and 
compare  them  to  experimental  results  and  Cramer-Rao 
bounds.  Agreement  among  the  calculated  and  experiment 
standard  deviations  confirms  validity  of  the  techniques 
and  lays  a  basis  for  tuning  and  optimizing  solutions  for 
estimating  positions  of  unmanned  ground  vehicles. 


1.  INTRODUCTION 

Within  the  context  of  conducting  the  basic  task  of 
navigating  autonomously  from  point  A  to  B,  an 
unmanned  ground  vehicle  (UGV)  system  must  have 
sufficient  knowledge  of  the  environment,  and  the 
abilities  to  navigate  anywhere  and  compute  its  position 
and  orientation.  These  UGV  capabilities  can  be 
summarized  into  three  questions:  “Where  am  I?”, 
“Where  am  I  going?”,  and  “How  do  I  get  there?”.  The 
following  paper  is  concerned  primarily  with  answering 
the  first  question  with  a  general  technique  known  as 
positioning  or  localization. 

Positioning  technology  is  an  essential  feature  for  the 
navigation  and  guidance  of  a  UGV.  Traditional 
categorizations  of  positioning  are:  Standalone  (dead 
reckoning  or  use  of  landmark  recognition),  satellite -base 
Global  Positioning  Systems  (GPS),  and  terrestrial-radio- 
based  systems  (Long  Range  Navigation  “C” 
configurations,  etc.).  Depending  on  the  requirements, 


conditions,  and  resources  in  an  application,  positioning  can 
employ  a  combination  of  these.  However,  there  exist  many 
navigation  and  guidance  challenges  which  include 
precision  issues,  fast  positioning  needs,  loss  of  signal  due 
to  environment,  etc.,  especially  in  indoor  environments 
involving  non-line-of-sight  conditions. 

Recent  growth  of  interest  in  pervasive  computing  and 
location  aware  systems  provides  a  strong  motivation  to 
develop  the  techniques  for  estimating  the  location  of 
UGVs  in  both  outdoor  and  indoor  environments.  There 
have  been  many  approaches  to  solve  this  problem 
including  TOA  (Time  Of  Arrival),  TDOA  (Time 
Difference  Of  Arrival),  and  ROA  (Received  signal 
strength  Of  Arrival)  which  are  location  aware  methods  that 
calculate  the  relative  distance  between  reference  nodes  and 
a  sensor  (UGV)  node  (Patwari  et  ah,  2003;  Wang  et  ah, 
2003;  Lee  et  ah,  2005).  TOA  uses  the  time  of  received 
signals  from  the  reference  nodes  to  calculate  distance.  This 
method  requires  accurate  time  synchronization  among  all 
of  the  sensor  nodes  and  reference  nodes.  In  the  case  of 
TDOA,  synchronized  reference  nodes  receive  signals  from 
a  sensor  node  and  calculate  time  differences  between  times 
on  which  each  reference  node  received  signals  from  the 
sensor  node.  These  techniques  provide  robustness  and 
precision  in  ranging  and  identification  of  the  transmission 
source  in  a  single  operation.  Advanced  systems  solution 
methods  can  be  used  to  compute  the  position  of  an  object 
(in  this  case  a  UGV)  based  on  the  TOAs  and  TDOAs. 
Uniqueness  of  this  system  is  the  ability  to  integrate 
UWB/RAC  electronics  with  TOA/TDOA  solutions  (Cheok 
et  ah,  2004). 

Analysis  techniques  involving  the  Cramer-Rao  bound 
(CRB)  provide  methods  for  calculating  a  lower  bound  on 
the  covariance  of  any  unbiased  positioning  estimator 
which  uses  connectivity,  TOA,  and  TDOA  measurements 
(Patwari  et.  al,  2005;  Chang  et  ah,  2006;  Rydstrom  et  ah 
2006).  This  lower  bound  is  useful  for  determining  the 
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'best-case'  positioning  algorithm.  The  CRB  on  estimator 
covariance  is  a  function  of:  the  number  of 
unknown/known  location  nodes;  sensor  geometry; 
dimensionality;  measurement/computation  type  (TOA, 
TDOA,  etc.);  channel  parameters;  and,  node 
connectivity. 

A  UWB  Location  Positioning  System  (LPS)  has 
been  set  up  for  navigating  and  guidance  of  UGVs  with 
the  main  objectives  of  analyzing  and  validating 
accuracies  of  the  UWB  LPS  in  locating  position.  This 
paper  not  only  addresses  the  problem  of  time-based 
positioning  using  a  derived  closed  form  solution,  but  also 
the  characterization  of  uncertainty  to  determine  the 
quality  of  solution  in  both  theory  and  experimental 
results. 


2.  EXPERIMENTS 

2.1  Experimental  Setup 

Figure  1  shows  a  MSSI  Sapphire  Precision  Asset 
Location  System  (PALS)  that  uses  UWB  technology  to 
RFID  and  locate  the  position  of  tagged  assets.  A  typical 
PALS  consists  of  a  central  processing  station  (CPS),  four 


Figure  1:  Multispectral  Solutions  Inc.  (MSSI)  Sapphire 
Precision  Asset  Location  System  (PALS). 


receivers,  a  reference  transmitter  tag  and  multiple  asset 
transmitter  tags.  The  receivers  are  positioned  at  known 
locations  and  cable  linked  directly  to  the  CPS.  The 
transmitter  tags  used  in  the  experiment  are  l”xl”xl/2”  in 
size,  have  a  range  in  excess  of  650  ft,  and  update  at  a  rate 
of  1,  15  or  60  samples/sec.  The  tags  transmit  sub¬ 
nanosecond  pulse  technology  that  can  penetrate  through 
multiple  obstructions  in  indoor  and  outdoor 
environments.  A  reference  transmitter  tag  is  required  to 
synchronize  the  clocks  in  the  receivers.  The  receivers 
receive  RFID  transmissions  from  asset  tags  and  feed  the 
time  of  arrivals  (TOA)  to  CPS.  Location  of  each  asset  tag 
is  then  computed  by  the  CPS.  The  PALS  claims  to  be 
capable  of  precision  tracking  accuracy  and  resolution 
better  than  4”.  Figure  2  depicts  a  bird’s  eye  view  of  the 
experimental  test  site  (Shotwell-Gustafson  Pavilion  at 
the  Oakland  University  SmartZone)  and  the  layout  of  the 


Figure  2:  Experimental  Setup. 

UWB  PALS  receivers  in  the  Pavilion.  Four  receivers  were 
mounted  at  (units  in  feet): 
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The  reference  tag  Tref ,  fixed  at  a  known  location,  is  used 
to  synchronize  the  clocks  in  receivers  Rj .  Let  tt  denote 
the  time-of-arrival  (TOA)  of  the  transmission  from  the 
object  or  asset  attached  tag  Ta  at  each  Rj  using  the 
synchronized  clocks.  Assume  that  the  clock  measurements 
tj  +  At,. ,  where  At,-  denotes  errors,  have  statistical 
properties  E(At,.)  =  0  and  E^At,2j  =  cjp.  aT  is  the  error 
variance  in  measurement  of  t,  and  represent  the  range 
resolution  of  the  UWB  LPS.  The  LPS  specifies  that 
<Tr  « 0.3x10  g  sec.  If  v  is  the  propagation  speed 
(v  =  0.98357  xlO4  fps)of  electromagnetic  wave,  then  the 
uncertain  measurement  errors  in  distance  or  range  are 
given  by  vpaT . 

In  the  above  setup,  the  receivers  were  mounted  at 
approximately  the  same  height  (nearly  coplanar).  This 
allows  us  to  simplify  and  perform  a  2-D  positioning 
analysis  and  testing  of  the  setup.  Let  the  2-D  location  of 
each  receiver  be  denoted  by, 


7  =  1,  2,  3,4, 


(2) 


and  that  of  the  asset  or  sensor  tag  be, 


LtJ, 


The  UWB  PALS  measures  the  distance  r,  by  clocking  the 
time-of-arrivals.  The  distance  relationship  between  the  tag 
and  receiver  j  is: 


2 


ri  =J(Xa-Xi)2  +(y a  -ytf 


The  diagonal  elements  of  QCRB  are  the  variance  bound  for 
estimation  of  sensor  a  location.  The  CRB  asserts  that, 


2.2  Problem  Statement 

Now,  suppose  that  the  location  of  the  sensor  is 
calculated  by  an  (any)  estimator  as[xa  TnJ-  Let  ex2 
be  defined  as  the  location  variance  of  the  estimator  as: 

<t;  =  var(xa )  +  var  (ya )  =  E(ifl2 )  +  E(j>2 )  (5) 

and  aa  being  the  standard  deviation.  The  following 
section  of  this  paper  will  compare  the  standard 
deviations  using  variances  computed  from  the  Cramer- 
Rao  Bound  (CRB),  TOA  method,  and  the  TDOA  method 
all  of  which  were  obtained  from  experimental  tests  from 
the  SmartZone  Test  setup. 

3.  RESULTS 


Ga  —  &CRB  —  Hxx,CRB  +  vy,CRB  (9) 

Figure  3  shows  an  application  of  CRB  to  the  UWB  LPS 
over  the  Test  Setup.  The  analysis  assumes  that  the  asset 


CRB  for  Std  Dev 


3.1  Cramer-Rao  Bound  (CRB) 

Let  H  denote  the  communication  status  between 
Sensor  a  and  the  receivers.  E.g.,  H  =  {1,  2,  3,  4j  if 
Sensor  a  makes  measurements  with  receivers  1,  2,  3  &  4; 
and  H  =  {1,  2,  4}  if  only  with  receivers  1,  2  and  4.  A 
Fisher  Information  Matrix  (FIM)  is  formed  as  follows: 


where, 


Fxx  =yYSxa~xi')1  ,rl 

ieH 

F<y  =  {xa  -  xi  X-L,  -  T< )  /  r! 

ieH 

Fyy = -  yJ2 1  ^ 

ieH 


(6) 


(7) 


For  TOA  analyses,  the  channel  constant  term  y  is 
The  CRB  matrix  is  the  inverse 


defined  as  y  =  - 

{y p^t  )" 

of  FIM  and  given  by, 


Figure  3:  Example  of  CRB  to  the  UWB  LPS  from  the 
experimental  setup. 

tag  (Sensor  a)  communicates  with  all  the  receivers, 
thus  H  =  {\,  2,  3,  4}. 


The  CRB  reveals  the  best  possible  standard  deviation 
crn  that  can  be  achieved  in  estimating  the  location  of 
Sensor  a  based  on  the  measurement  configuration. 


3.2  Time-Of- Arrival  (TOA)  Method 


The  TOA  method  calculates  location  pa  =  \xa  ya  J 
based  on  knowing  the  range  measurements  r . 
Manipulating  the  relationship, 

f  =(x a -x,  f  +(ya-y if  ’  *  =  !>■■■> 4  (!°) 


yields  x  &  y  as, 


=  j[A  roA 
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(ii) 
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where, 


3 


(16) 
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,  [  J  denotes  the  generalized 


inverse  matrix  operation,  and  hi  =  xf  +  yf  ,  x  .  =  xt  -x . 

&  yUj=yi-yj- 


A  TOA  measurement  with  error  can  be  expressed  as, 

6  +  Tlr  =Vp  [t,  +  T),  )  (12) 


where  tt  + i),  is  the  time  of  arrival  with  time  errors.  In  the 

TOA  case,  T]r  =vpT]t  and  EO72)  =  a]  =  [vpcrT )  .  The 

TOA  measurements  inject  errors  in  the  calculations  as 
follows: 

hi  ~hl  -  ( (r2  +  77,.  )2-(rl  +  >),.  f ) 

hl  ~hl -{(r3+  >lr,)2  ~  (r2  +  %  )2 ) 

h]  ~  hi  -  ((/'4  +  77r<  )2  -  (r3  +  77,.  )2 ) 

hi  ~  hi  -((/i+  /),.  )2  -  (r4  +  77,.  )2 ) 

(13) 

It  can  be  shown  that 
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-  rAir,  _ 

where  we  apply  the  fact  that  rt  » ijr  in  the  last 

expression.  It  follows  that  the  variance  of  estimation 
using  TOA  method  is  given  by, 
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(15) 


A  combined  measure  of  the  variance  of  the  TOA 
computed  location  pTOA  =  [x  }’^TOl  can  be  expressed  as 


aTOA  ~  ’l xx, TOA  +  QyyJOA  • 

Figure  4  illustrates  standard  deviation  aTOA  for  the 
experimental  UWB  LPS. 


TOAStd  Dev 


Figure  4:  TOA  standard  deviation  for  the  experimental 
UWB  LPS. 


3.3  Time-Difference-Of-Arrival  (TDOA) 

The  TDOA  method  calculates  the  location 
Pa  =  [*„  y a  ]  us>ng  the  difference  in  distances 

ri,\=ri-ri=vp{t,-h),  /  =  2,3,4  (17) 


where  r  can  be  computed  from  TDOA  ((.  -( )  ■  It  can  be 
shown  that, 


2,d  2  2 

6,1  +  2ri,  16  =  6  -  6 


=  hl  -hi  -2x,,x-2 yuy 


(18) 


which  leads  to  the  closed-form  TDOA  relationship. 
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where  A, 
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the  TDOA 

4 


TDOAStd  Dev 


case,  cr2  =  E (n2r  )  =  2cr2r  .  Introduce  the  measurements  in 
the  TDOA  relationship  as  follows: 
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It  can  be  shown  in  practice  that  the  conditions  where 
77,, |  and  A rx  «:  rx  are  often  true.  Then  it  follows 

that. 
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The  variance  of  the  errors  in  the  TDOA  computation  is 
given  by, 


Figure  5:  TDOA  standard  deviation  for  the  experimental 
UWB  LPS. 

relationships  to  supplement  the  information  for  the 
TDOA  relationships.  Work  on  configuring  TDOA 
parameters  to  maximize  their  performance  is  underway 
and  will  be  reported  elsewhere. 
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where  cr;  =  2 erf  as  noted  earlier.  A  combined  measure 
of  the  variance  of  the  TDOA  computed  location 

P  tdoa  =  [*  yfTDOA  can  be  expressed  as, 


CT  T 


=  <?x 


,+q 


yy,TDOA 


(23) 


The  standard  deviation  <JmoA  for  the  experimental  UWB 
LPS  was  computed  for  grid  points  over  the  Pavilion,  and 
plotted  in  Figure  5. 

It  is  seen  that  aTDOA  becomes  excessively  large  at 
certain  locations.  This  is  due  to  A  TD0A  being  ill- 
conditioned  at  those  locations.  The  situation  can  be 
minimized  by  re-configuring  the  locations  of  the 
receivers.  Alternatively,  one  can  formulate  additional 


3.4  Experimental  Results 

Experiments  were  conducted  to  measure  and 
compute  the  statistical  variance  of  the  MSSI  PALS.  A 
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Figure  6:  Actual  standard  deviations  from  the  UWB 
PALS. 


total  of  23 1  sets  of  experimental  data  were  collected  with 
sensors  statically  placed  over  evenly  spaced  11  x  21 
grids  in  the  Pavilion.  Each  set  of  experiment  data 
consists  of  approximate  500  readings  of  the  location  [x  y 
z]’  of  the  sensor  at  a  particular  location.  The  statistical 
mean  and  variance  were  then  computed.  Figure  6  shows 
the  standard  deviations  obtained  from  the  experiments. 
It  is  noted  that  the  general  distribution  property  of 
standard  deviations  from  the  experimental  data 
resembles  that  of  the  TDOA.  This  indeed  should  be  the 
case  since  the  MSSI  PALS  employs  a  TDOA  technique 
to  generate  a  location  estimate. 

3.5  Comparison  of  Results 

Figure  7  superposes  and  compares  the  standard 
deviations  computed  from  the  CRB,  TOA  and  TDOA 
techniques  and  the  experimental  data.  Observe  that  the 
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Figure  7:  Comparison  of  standard  deviations  from 
experiment  data,.  TDOA,  TOA  and  CRB  calculations. 

CRB  really  is  lower  bound  for  the  other  standard 
deviations.  The  TOA  and  TDOA  deviations  are  very 
close  to  one  another,  except  that  TDOA  deviations 
deteriorate  at  ill-conditioned  locations.  The  experimental 
standard  deviations  are  larger  than  all  the  other 
deviations.  This  can  be  expected  since  many  additional 
factors  contribute  to  measurements  errors  in  practice. 


Overall,  the  CRB  calculation  is  verified  with  results  from 
the  TOA,  TDOA  and  experimental  analysis. 

The  CRB,  TOA  and  TDOA  calculations  were  based 
on  parameters  provided  by  the  manufacturer,  and  on 
physical  layout  of  the  receivers.  In  practice,  the 
experimental  results  can  be  used  as  reference  data  for 
adjusting  the  parameters  for  the  system. 


4.  CONCLUSION  AND  FUTURE  WORK 

The  results  shown  in  Figure  7  provide  a  significant 
opportunity  for  performance  improvement  involving  the 
navigation  of  autonomous  systems.  Since  these  systems 
rely  heavily  on  their  ability  to  acquire  their  accurate 
position,  the  improvement  in  this  ability  will  result  in 
superior  results  for  the  waypoint-following  and  target 
tracking. 

The  Cramer-Rao  Bound  provides  for  a  technique  to 
predict  a  lower  bound  for  the  standard  deviation  of  the 
TOA  or  TDOA  position  calculation  using  UWB  range 
measurements.  These  predictions  can  be  used  to  evaluate 
the  quality  of  position  calculations  for  a  series  of 
combinations  of  range  measurements.  In  other  words, 
with  the  CRB,  the  navigation  system  is  now  able  to 
evaluate  the  ‘quality’  of  a  combination  of  range 
measurements,  and  to  decide  which  combination  is  best 
to  use  for  the  calculation  of  the  vehicle’s  position. 

The  experimental  data  validates  the  analyses  for 
CRB,  TOA  and  TDOA,  in  that  it  envelopes  or  form  an 
upper  bound  for  calculated  the  standard  deviations.  The 
theoretical  analyses,  verified  by  practical  experiments, 
can  therefore  be  applied  to  other  algorithms  with 
confidence.  This  is  also  an  important  contribution  of  the 
paper. 

For  military  applications,  unmanned  systems 
technology  with  accurate  positioning  can  greatly  benefit 
the  soldiers/operators  by  reducing  dangerous  tasks  to 
robotic  operations,  therefore  potentially  preventing  harm 
and  saving  the  lives  of  soldiers.  One  such  application  is 
for  anti-personnel  mine  detection,  using  the  Future 
Combat  System  (FCS)  Small  Unmanned  Ground  Vehicle 
(SUGV)  system.  Such  an  application  requires  high- 
precision  navigation  technology  to  conduct  accurate 
sweeps.  We  feel  that  our  proposed  RF  navigation  system 
can  provide  a  potential  solution  for  path  planning, 
mobility,  and  control  algorithm  development. 

Future  work  will  involve  further  analysis  of  the 
matrices  to  include  eigen-structure  analysis  for 
determining  conditioning  of  the  matrices.  This  will  assist 
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in  understanding  the  measurements  as  well  as  provide 
potential  strategies  of  where  to  place  the  receivers. 
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